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Abstract 

A geometric approach to kinematics in control theory is illustrated. A 
non-linear control system is derived for the problem and the Pontryagin 
maximum principle is used to find the time-optimal trajectories of the 
Parallel navigation. The time-optimal trajectories of the Parallel naviga- 
tion are characterized through a geometric formulation. It is notable that 
the approach has the advantages using feedback^] 

Keywords: Finsler geometry, Parallel navigation, Kinematics, Optimal 
control, Pontryagin maximum principle. 

1 Introduction 

The historical development of what became the Calculus of Variations is closely 
linked to certain minimization principles in the majority subjects in mechan- 
ics, namely, the principle of least distance, the principle of least time and ul- 
timately, the principle of least action [7j. To understand solution of the well- 
known brachistochrone problem, (i.e finding a curve from point A to point B 
along which a free-sliding particle will descend more quickly than on any other 
Ai?-curve), we are led through Fermat's principle of least time: light always 
takes a path that minimizes travel time. 

The Parallel navigation, or briefly P-navigation, is a quiet old problem and has 
been studied using several techniques from the viewpoints of kinematics and 
dynamics in optimal control theory |17j . The application of Finsler geometry 
in Physics, seismology and Biology is a subject of numerous papers such as [T], 
El- , IS], ED, [H], [IS], [IE], e * c - Let O be the origin of an inertial reference 
frame of coordinates (FOC). The positions of M and T in this (FOC) are given 
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by the vectors tm = OM and yt = OT, respectively. In two-point guidance 
systems, the vector r = rx — ym is conventionally called the range. Its time 
derivative r = yt — ym = - vj/ is the relative velocity between the two 
objects, and v T and v M are the velocities of T and M, respectively. W always 
denote the vectors by bold face and their norms will be shown by the same nor- 
mal letter. As an application, it is notable for mariners wishing to rendez-vous 
each other at sea. M could be a boat and T, a tanker with fuel for it (or vice- 
versa). Or, back in history, T could be a merchantman and M a pirate ship. 
This rule assumes, of course, constant speeds. Thus, in most realistic cases, vt 
and Vm are supposed to be constant. However, it is easy to extend the theory 
if they are not constant. The closing velocity, a term often used in the study of 
guidance, is simply vp = — r. Notice that, we wish to study the kinematics of 
P-navigation in a relative (FOC) rather than a absolute one, i.e., we shall seek 
the location of M in a (FOC) attached to T. Thus, a trajectory in the relative 
(FOC) shows the situation as seen by an observer located at T. As the special 
cases, we assume that M = R 3 or M = R 2 . In reality, the velocity vy and yt 
can be detected and reported at any r by a grounded radar. Suppose that S(r) 
be the angle between vm and MT and given any 8, there is Finsler metric F 
given by: 

Ivl 2 

F(Y, V, S) = r, (1) 

ujwcosd|v| — (v, vt) 

where, |.| denotes the Riemannian norm on M. A solution of the described 
P-navigation is a curve (r(t),8(i)) such that respects the required constraints 
on velocities. 

Theorem 1.1 Given any solution (y,8) of parallel navigation, the curve r can 
be reparametrized so that it satisfies F(r(t),v(t),8(t)) = 1. 

The indicatrix S(y, 8) of the metric ([lj is the set of unit tangent vectors v 
with respect to ^ which is defined by S(y,8) = {v G T T M | F(r,v,S) = 1}. 
Following Theorem |1.1[ at any time t we have r = v e S(y,S). Hence, at any 
time t, there is a unit vector /(r, 8) € S(y, 8) such that r = v = /(r, 8). 
Control problems typically concern finding a (not necessarily unique) control 
law 8(.) , which transfers the system in finite time from a given initial state 
Xi = r(0) , to a given final state zj — Y(tf). This transition is to occur along 
an admissible path, i.e. r(.) and respects all kinematic constraints imposed on 
it. Let us consider it as 

Y = f(Y,S). (2) 

We further assume that <J(.) is admissible, i.e. is piecewise continuous and 
belongs to U , the admissible control space. Let there now be a rule which 
assigns a unique, real-valued number to each of these transfers. Such a rule can 
be viewed as the transition cost between xi and Xf along an admissible path, 
completely specified by 8(.). The Optimal control concerns specifying this rule 
and thereby providing a systematic method for selecting the best, or optimal 
control law, according to some prescribed cost functional. One can find an 
analogue discussion in [5], to calculate the travel-time along the trajectories of 



2 



the so called Pure pursuit navigation. Here, the P-navigation optimal control 
problem can be founded by the cost function C(r, S) = F(t,t,6) and has the 
following form 

minimize / C(r,6)dt, (3) 
Jo 

where, tf £ (0, oo) is the final time which is going to be optimized. From 
everyday experience we know that collision courses need not be straight lines if 
T changes its speed or direction; so what is exactly the collision course? It may 
be curved in some sense. One of our goal in this paper is to make known the 
best collision course. 

Theorem 1.2 Given any time- optimal solution (r, i5) of P-navigation, the curve 
r is a geodesic of the Finsler metric £7]). 

The trajectory ym can be obtained ym — ?t r when r is known. One can 
freely consider vm and vy as vector fields alon r. Now, let be the covariant 
derivative defined for any vector field Y along r defined by 

where, Gj k are the connection coefficients of Berwald connection associated to 



the Finsler metric (JfJ. As a result of Theorem 1.2 we can mention the following 
result: 

Theorem 1.3 The time-optimal trajectory ym of P-navigation satisfies the fol- 
lowing second order ODE: 



*M + G ifc( r > v > <5) v m v m = i=l,...,n. 



Our approach is closely related with subjects such as non-holonomic mechanics, 
sub-Finslerian geometries, see for a deeper sight [8 and !4j. One may find 
various techniques in missile guidance and control in |17j . 



2 Preliminaries 

Let M be a n-dimensional C°° manifold. T X M denotes the tangent space of M at 
x. The tangent bundle of M is the union of tangent spaces TM := U^gjw T X M. 
We will denote the elements of TM by (x, y) where y £ T X M. Let TM = 
TM \ {0}. The natural projection it : TMo — > M is given by tt(x, y) := x. 
A Finsler metric on M is a function F : TM — > [0, oo) with the following 
properties; (i) F is C°° on TMo, (ii) F is positively f-homogeneous on the 
fibers of tangent bundle TM, and (iii) the y-Hessian of \F 2 with elements 
gij(x,y) := \ [F 2 (x, y))yi v o is positive definite on TM . The pair (M,F) is then 
called a Finsler space. The Riemannian metrics are special Finsler metrics. 
Traditionally, a Riemannian metric is denoted by aij{x)dx l ® dx 3 . It is a family 
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of inner products on tangent spaces. Let a(x, y) := \J 'gij{x)y l y J , y = 2/ l gfrU e 
T X M . a is a family of Euclidean norms on tangent spaces. Throughout this 
paper, we also denote a Riemannian metric by a = ■J aij(x)y % yi . 

An (a, /3)-metric is a scalar function on TM defined by F :— where 
<p = 4>(s) is a C°° on (— bo, bo) with certain regularity, a = ^/ a i , J (x)y l yi is a 
Riemannian metric and /3 — bi(x)y' 1 is a 1-form on a manifold M . One may find 
another important class of (a, /3)-metrics in [16] . The Randers and Matsumoto 
metrics are special (a, /3)-metrics defined by $ — 1+s and $ = respectively 

2 

i.e, i* 1 = a 4- p and F = . Randers metrics were introduced by Randers in 
1941 [T2] in the context of general relativity. In [<o\ , applying Fermat's principle, 
the authors proved that the time-optimal solutions of the well-known Zermelo's 
navigation-moving that is the motion of a vehicle equipped with an engine with 
a fixed power output in presence of a wind current-are actually the geodesies of 
a Randers metric. M. Matsumoto gave an exact formulation of a Finsler surface 
to measuring the time on the slope of a hill and introduced the Matsumoto 
metrics in [5], see also [T5] , 

A Lagrangian on the manifold M is a mapping L : TM — > R which is 
smooth on TMq. A Lagrangian is said to be regular if it has non-degenerate 
y- Hessian on TMq. Thus, given a Finsler metric F, the function L = is a 
regular Lagrangian. A large area of applicability of this geometry is suggested 
by the connections to Biology, Mechanics, and Physics and also by its general 
setting as a generalization of Finsler and Riemannian geometries |10j . For every 
smooth curve c : [a, b] — > R, the extremal curves of the action integral given 

by 

1(c) = f L(c(t),c(t))dt, (4) 



are characterized locally by the Euler- Lagrange equations given as follows: 

dtdx* dx l 1 ' 

where, is a local coordinate expression of c. The extremal curves of the 

action integral Q are usually called the geodesies of L. In 1 it is shown that 
the Lagrangian and Finslerian approaches are projectively the same. 
Given a Finsler manifold (M,F), a globally defined vector field G is induced 
by F on TMq, which in a standard coordinate (x l ,y l ) for TMq is given by 
G = y'gfr — 2G l (x, y)-jfjjt, where G l (x, y) are local functions on TMq satisfying 
G l (x,Xy) — X 2 G 1 (x,y) , A > 0, see [13]. G is called the associated spray to 
(M,F). In local coordinates, a curve c(t) is a geodesic of F if and only if its 
coordinates (c l (t)) satisfy c % + 2G l (c, c) = 0. 

2.1 The kinematics of Parallel navigation 

We shall refer to the target as T and to the pursuer as M and their velocities 
as vm and vt, respectively. To begin, we set up a coordinate system called 
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Figure 1: The range v, the velocity vectors vjj and Vy. 



reference frame of coordinates, in which the pursuer is initially located at the 
origin O. When considering planar motion we shall use Cartesian coordinates 
(x, y) or (x, z), and the angles will be positive if measured counterclockwise. The 
ray that starts at the pursuer M and is directed at the target T along the positive 
sense of r is called the line of sight (LOS). The parallel navigation geometrical 
rule, has been known since antiquity, mostly by mariners. According to this rule, 
the direction of the line of sight, MT, is kept constant relative to inertial space, 
i.e., the LOS is kept parallel to the initial LOS. In three-dimensional vector 
terminology, the rule is very concisely stated as r x r = 0. Suppose that 6 and A 
denote, respectively, the angles between and vm and, vm and the horizontal 
axis (Figure [TJ. 

Let us put r = |r|. The basic rule for moving of the pursuer is presented by 
the following two equations [17]: 

r = vt cos 9 — vm cos 8, (6) 
r\ = vt sin 9 — vm sin 8. (7) 

Notice that, in a planar framework, Vm , v*r and r being on the same (fixed) 
plane by definition, therefore, the parallel navigation geometrical rule can be 
restated as A = 0. The requirement (r, v) < must be added in order to ensure 
that M should approach T not recede from it. In this case, we have r < 0, that 
is Vt cos 9 < vm cos 8. Let us denote the projection of any vector on v by 
Proj v VT- A solution of the described P-navigation is a curve (r(t),8(t)) such 
that respects the equations ^ and f?\ . By the trajectory of P-navigation, we 
mean a curve r(t) such that (r(i), 8(t)) is a solution, for some control 8. 

Initiating the process, we have r(0) = ro which shows that, M stands at a 
point with distance ro from T. Through the performance, r decreases by time 
and hence, M approaches T. Therefore, r tends to the origin O and M hits 
T when r(tf) — 0, (Figure [2]). It follows that, P-navigation trajectories are 
characterized by a curve r joining Q = ro to the origin O (Figure |3j. It is of 
our interests to find the best QO-trajectory. More precisely, the problem is to 
find a curve from point Q to point O along which a particle will descend more 
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Figure 2: Some possible ranges initiated at the point Q. 




Figure 3: Schematic of exemplary collision courses for M . 



quickly than on any other QO-curve of P-navigation. In this way, the problem 
somehow resembles to a brachistochrone problem. 



3 The optimal control theory. 

A control system of ordinary differential equations is a family of differential 
equations in normal form = f l (r,S), where r* are called state variables, t 
is the parameter of evolution (usually the time) and S a are the controls. Ge- 
ometrically, it can be regarded as a fibred mapping X : U — 5- TM, from a 
control fiber bundle (U, r), M) over the state manifold M to the tangent bundle 
(TM,n,M), see [TT]. Using local coordinates (r l ), i = 1, ...,n in M, adapted 
coordinates (r l ,S a ), a = 1, k in U, and natural coordinates (r l ,v*) in TM, 
the coordinate expression for X is X(r,S) — f l (r,5)-J^i , or v l = f l (r,8), 
the family of control equations. Admissible curves of the control system are 
curves j : I C R — > U such that (no-f) c — Xoj, where c denotes the natu- 
ral lifting to TM of a curve in M. Interested readers are advised to see [TT] 
for getting familiar to the geometry of control systems. In Optimal Control 
Theory, a cost functional C('y) = J C(r(t), 5(t))dt is given and the goal is to 
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obtain admissible curves of the control system, satisfying some boundary con- 
ditions (e.g. Xi = r(0), Xf = r(tf)) and minimizing the cost functional. It 
is therefore a Classical Variational problem with non-integrable constraints de- 
fined by the control equations. Pontryagin maximum principle 12J provides a 
set of necessary conditions for a solution (r(t),S(t)) to be optimal; introducing 
a Hamiltonian function 

H(r,p,S) := (p,X)-C(r,5)=p i f(r,S)-C(r,6), 
H(r,p) := max H(r,p,d). 

O 

where the variables (pi) are momenta coordinates, the optimal curves (r(t), S(t)) 
must satisfy the control system equations 

f)Ff 

v< = ^< = /*(*(*). *(*)) 

and there must exist a solution curve for the adjoint differential equations 

dpi dH 
dt dr 1 ' 

Define the Lagrangian L by L(r, v) = p^v* — H. Observe that we have the 
following relations 

dr _ dH _ dp dH _dL dH _ dL _ () 

dt dp ' dt dr dr' dv ^ dv 

From the above equations, it results the well-known Euler-Lagrange for L 

d_dL_ _dL_ {} 
dt dv dr 

Proposition 3.1 \12j In order for (r(t),S(t)) to be an optimal solution of Q), 
the following are necessary conditions: 

(a) There exists a solution curve for the adjoint differential equations 

dpi dH 
~dt ~ ^Sr 7 ' 

(b) 5 = arg max H(r,p,S), Vte[0,t/]. 

s 

(c) H{r,p) = Q, Vt6[0,i/]. 

4 Proof of Theorems. 
4.1 Proof of Theorem 11.11 

Let (r(t),6(t)) be a pair of the curve r and a function 6(t). We are going 
to show that, if (r(t),6(t)) be a solution of P-navigation, then t(t) must be 
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reparametrized so that we we have F(r(t),r(i), S(t)) = 1. We notice that, in 
P-navigation, r and v are collinear and r < 0, hence we have 

(r,v) 

f = — - — = ±\Proj r ~v\ — ±\Proj v v\ = — |v|. 
Now, we summarize (|6| in the following relation 

|v| = v M cos5 rn — . 

After simplification, we obtain the following equation 



F(T,V,S) = r = f. 

v M cos5|v| - (v T ,v) 



Q.E.D. 



4.2 Proof of Theorem IP 

Following Theorem at any time i we have r = v G S(r, S). Hence, at 
any time t, there is a unit vector X(r,S) £ S(r,5) such that r = v = X(r,5). 
Consider the unit canonical vector field £(r,r,S) — p^rjy- We notice that, in 
P-navigation framework, we always assume that r and r are collinear and hence, 
one can understand £ as a function of r and S, as well. It follows that, given 
any trajectory r of P-navigation, X is given by X(r,5) = £(r, f, S). Therefore, 
it is clear that, 

(p,X) = Pi f(r,5)= Pi £ i (r,r,S) = F(r,r,6), 
(p,v) = p^ = F 2 (r,r,6). 

Now, we return to the control system of P-navigation given by (J2| with the cost 
functional C(r, 5) = F(r, r, 5). It is easy to verify that, H = 0, H = and one 
may consider S as any possible control law. The conditions of Proposition 3.1 
holds as well and the Lagrangian L~ s = (p, v) — H is obtained as 

^(r,r)=F 2 (r,r,5). 

Therefore, based on Pontryagin maximum principle, the optimal trajectories 
r(t) are geodesies of the Lagrangian L~ s . Clearly, they are geodesies of the 
Finsler metric F(v,v,5). 

Now, consider the control-parametric family of Finsler metrics defined by 
Fg(r, r) := F(r, r, 5). Let £5(7) = J / Fgfa, j)dt be the length of any admissible 
curve j(t) on (M, F5). A simple calculation gives the following inequality: 

i^o ( r , i") < Fg(r,r), for all possible controls S. 

From that, it follows that the functional £5(7) takes its minimum at S = 0, that 
is 

£0(7) < £5(7), for all possible controls S. 
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Figure 4: Collision course for a target moving on a straight line at a direction 
with a constant angle 9 . 



Therefore, to find a time-optimal solution, one should minimize the cost func- 
tional £(7) = J Fo(7,7)<it and this leads us to obtain it as a geodesic of Fq. 

Q.E.D. 

Theorem 4.1 The time- optimal trajectory of ' F '-navigation is a geodesic r(t) of 

i i 2 

the Finsler metric Fq = — , v| , r. 

However, given any control law, one may obtain a geodesic of the metric Fg as 
the time-optimal trajectory. As a remark, we quote that the target T may not 
be reachable by the control 5 = 0. 

Example 4.1 (Case of plane nonmaneuvering target.) The target T is said to 
be nonmaneuvering ifa.x — 0. In this case, T moves on a straghit line at velocity 
Vt in the direction with a constant angle 8 if measured counterclockwise, see 
Figure [^J Let us suppose vxix 1 , x 2 ) — VT{cos#ogfr +sin#og§2-}- Thus, from 
, it follows that 8 = sin~ 1 ( su ^" ) ; where, K is the velocity ratio K = 
en, S is a constant say Sq- Moreover, Vj- is a parallel vector field and then 
Fg is a Minkowski metric and is flat. Thus, it geodesies are straight lines. We 
obtain r(t) = r + £v . But, from we have |v| = |v | = % cos S — vt cos 0q . 
Intercept occur when we have v{tf) — 0, thus, the total flight time tf is obtained 
by 

, ro ro 

v M cos S Q — v T cos 6 vt(K cos S — cos 9 ) 

and the total range of M equals ro which is the shortest curve joining Tq to the 
origin O. 
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